#!/usr/bin/python
# -*- coding: UTF-8 -*-
import sys;
sys.path.append("..")
from lib.BwRobotLib import BwRobotLib
from RobotBipe4T.Bipe4TRobot import Bipe4TRobot
import keyboard
import time
import os

robotlib = BwRobotLib()
bipeRobot = Bipe4TRobot(robotlib)

#连接机器人设备
#robotlib.connectRobot("10.10.100.254",8899)
robotlib.connectRobot("192.168.3.46",55002)

#加载配置
robotlib.loadConfig(os.path.dirname(__file__)+"/config.txt")

#配置ID
bipeRobot.bindIds(robotlib.module_ids)

#-----------------------------------------------------------------------------
#复杂双足
#-----------------------------------------------------------------------------


print("Enter any key to initialize....")
input("")
bipeRobot.quickInit()
while(1):
  print("Enter any key to run ....")
  input("")
  bipeRobot.runDemo()


